BERNHARD DIRSCH & HANS-PETER TRONDLE, citizens of 
Germany, whose residence and post office addresses are Westerwaldweg 27, 
91056 Erlangen, Germany; and SQdhang 14, 91301 Forchheim, Germany, 
respectively, have invented certain new and useful improvements in a 


METHOD FOR ENHANCING THE CONTROL RESPONSE OF A 
DRIVE TRAIN HAVING BACKLASH AND/OR ELASTICITY OF A 
MACHINE TOOL OR PRODUCTION MACHINE 


of which the following is a complete specification: 


METHOD FOR ENHANCING THE CONTROL RESPONSE OF A 
DRIVE TRAIN HAVING BACKLASH AND/OR ELASTICITY OF A 
MACHINE TOOL OR PRODUCTION MACHINE 


CROSS-REFERENCES TO RELATED APPLICATIONS 

[0001] This application claims the priority of German Patent Application, 
Serial No. 103 02 374.7, filed January 22, 2003, pursuant to 
35 U.S.C. 119(a)-(d), the disclosure of which is incorporated herein by reference. 

BACKGROUND OF THE INVENTION 

[0002] The present invention relates to a method for enhancing the control 
response of a drive train with backlash and/or elasticity, and more particular a 
drive train of this type employed in a machine tool and production machine. In the 
application, the term "production machine" is used here in a generic sense and 
includes also robots which generally follow the concepts outlined here. 

[0003] Machine tools and production machines, including robots, 
frequently include gears and/or couplings inserted between a drive motor and the 
driven load. The gears and couplings typically have play, which produce an 
elastic behavior or backlash between the drive and the load. Backlash has the 
undesirable effect on a control system that the force that must be produced by 
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the motor is almost zero up to a certain point or displacement distance, and that 
from that point on the motion can only be sustained by applying a significantly 
greater force than the initial force. 

[0004] Backlash is produced, for example in gears employing toothed 
wheels, wherein a tooth of a first gear wheel is located exactly between two teeth 
of a second gear wheel. When the drive motor connected to, for example, the 
first gear wheel starts up, only a very small force is required for moving the first 
gear wheel. However, when a corresponding tooth of the first gear wheel 
contacts a tooth of the second gear wheel connected with load, the motor 
requires a significantly greater force for continuing the travel motion. 

[0005] The mechanical components used in gears and couplings also 
have elasticity, which do not permit a direct proportional relationship between 
motor speed and the speed of the load, in particular for a dynamic motion. 

[0006] Accordingly, backlash and/or elasticity necessitate a nonlinear 
characteristic of the controlled system. 

[0007] In conventional applications, the controlled valuable supplied to a 
speed controller that controls the motor speed is either an actual motor speed 
that is measured directly on the motor or a load speed that is measured 
proximate to the load. Both methods have certain disadvantages. Due to the 
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aforementioned backlash and/or elasticity, the motor speed is not identical to the 
load speed, in particular in dynamic processes. 

[0008] If the motor speed is used as the only controlled valuable, then the 
control amplification of the controller can disadvantageously not be set to reflect 
the entire mass of the controlled system, which is composed of the mass of the 
load, the mass of the motor and the mass of the gears, because the 
aforementioned individual masses cannot be viewed as a single rigid total mass 
due to the existing backlash and/or elasticity. Since the control amplification of 
the controller is typically set to optimize the damping behavior of the system, the 
control amplification must be kept low, which adversely affects the control 
response. 

[0009] If the load speed is used as the only controlled variable, then the 
control circuit tends to exhibit instabilities, because the electromechanical 
components have a rather small mechanical damping during torque reversal and 
the backlash and/or elasticity also contribute a small torque. In this case, the 
control amplification of the controller can be adapted to the load, which permits 
high control amplification with an excellent control response. A system control 
based on controlling the load speed, however, can only be implemented when 
the mechanical components of the drive system are very stiff. Accordingly, such 
control methodology is typically not implemented in a drive system where a gear 
is inserted between the motor and the load, since such system lacks stiffness 
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and, more particularly, the gears exhibit backlash or play. Such control 
methodology is typically employed in drive systems where the motor, for example 
a torque motor, is coupled directly to the machine shaft. However, a favorable 
control response can only be attained at the expense of a relatively complex and 
expensive drive system. 

[0010] A methodology of the aforedescribed type is depicted, for example, 
in the NC/CNC Handbook 95/96, by Hans B. Kief, published by Carl Hanser 
Verlag Munich Vienna, 1995, page 189, FIG. 1a, which describes the use of a 
combination of two measurement signals in a control circuit. 

[0011] It would therefore be desirable and advantageous to provide an 
improved method for enhancing the control response of a drive train, which 
obviates prior art shortcomings and is able to specifically control drive trains 
having inherent backlash and/or elasticity, in particular of machine tools, 
production machines, and robots. 

SUMMARY OF THE INVENTION 

[0012] According to one aspect of the invention, a method for enhancing 
the control response of at least one drive train of a machine tool or production 
machine, wherein the at least one drive train includes a motor and a load coupled 
to the motor with backlash and/or elasticity, includes the steps of measuring a 
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motor speed on the motor, measuring a load speed proximate to the load, 
computing a combined signal comprising a weighted measured motor speed and 
a weighted measured load speed, and controlling the motor speed with the 
combined signal. 

[0013] According to another aspect of the invention, a method for 
enhancing the control response of at least one drive train of a machine tool or 
production machine, wherein the at least one drive train includes a motor and a 
load coupled to the motor with backlash and/or elasticity, includes the steps of 
measuring a motor speed on the motor, measuring a load speed proximate to the 
load, computing a weighted difference between the measured motor speed and 
the measured load speed, adding the measured load speed to the weighted 
difference to form a combined signal, and controlling the motor speed with the 
combined signal. 

[0014] Advantageous embodiments of the invention may include one or 
more of the following features. The weighted measured motor speed can be 
computed by multiplying the measured motor speed by a parameter (a) and 
weighted measured load speed is computed by multiplying the measured load 
speed by a parameter (1-a). Alternatively, the weighted difference can be 
computed by multiplying an actual difference between the measured motor 
speed and the measured load speed measured motor speed by a parameter (a). 
The parameter a can have a value between zero and one. 
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BRIEF DESCRIPTION OF THE DRAWING 


[0015] Other features and advantages of the present invention will be 
more readily apparent upon reading the following description of currently 
preferred exemplified embodiments of the invention with reference to the 
accompanying drawing, in which: 

[0016] FIG. 1 is a first embodiment of the method for enhancing the 
control response of a drive train according to the invention; and 

[0017] FIG. 2 is a second embodiment of the method for enhancing 
the control response of a drive train according to the invention. 

DETAILED DESCRIPTION OF PREFERRED EMBODIMENTS 

[0018] Throughout all the Figures, same or corresponding elements are 
generally indicated by same reference numerals. These depicted embodiments 
are to be understood as illustrative of the invention and not as limiting in any way. 
It should also be understood that the drawings are not necessarily to scale and 
that the embodiments are sometimes illustrated by graphic symbols, phantom 
lines, diagrammatic representations and fragmentary views. In certain instances, 
details which are not necessary for an understanding of the present invention or 
which render other details difficult to perceive may have been omitted. 
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[0019] According to the method of the invention, the variable to be 
controlled is formed by a combination of the motor speed n mo tor measured on the 
motor and the load speed ni oa d measured proximate to the load of the drive train. 
This approach increases the first mechanical resonance frequency of the 
controlled system which determines attainable control response. The motor 
speed n mo tor can be, for example, a motor rotation speed (RPM) or, for linear 
motors, a travel speed of the motor. The load speed ni oa d can be, for example, a 
rotation speed of the load or a travel speed of the load, for example, along an 
axis of a machine. 

[0020] Turning now to the drawing, FIG. 1 shows a block circuit diagram of 
a first embodiment of the method of the invention, with a motor 2 being 
mechanically coupled with a load 4 through a gear 3. The motor 2, the gear 3 
and the load 4 form a drive train 19 which is indicated in FIG. 1 by a dotted line. 
A rotation speed sensor 5 located proximate to the motor 2 transmits the 
measured motor speed n mo t or to a multiplier 7. A rotation speed sensor 6 located 
proximate to the load 4 transmits the measured load rotation speed n toa d to a 
multiplier 8. The measured motor speed n mo tor is multiplied in multiplier 7 by a 
parameter a to compute a weighted motor rotation speed 1 1 which is transmitted 
to an adder 9. The measured load speed ni oa d is multiplied in multiplier 8 with a 
factor (1-a) to compute a weighted load speed 12 which is also transmitted to the 
adder 9. The weighted motor speed 11 and the weighted load speed 12 are 
added in adder 9, thereby producing a combined signal n mea s which represents 
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the quantity to be controlled. The difference between the combined signal n mea s 
and a desired speed value beared is transmitted as an input variable to a 
controller 10, which can be, for example, a proportional-integral (PI) controller. 
The controller 10 at generates at the controller output a control signal 16 which is 
supplied to a power controller 1 . The power controller 1 controls and/or powers 
the motor 2 via an electrical connection 17. 

[0021] In FIG. 1, the combined signal n meas is calculated using the 
following equation 


structure depicted in FIG. 1 is dominated entirely by the load characteristic, 
whereas for the limit a =1 , the control structure is dominated entirely by the motor 
characteristic. 



(1). 


[0022] 


As seen from the above equation, for the limit a =0, the control 


[0023] 


The transfer function from the motor torque Mm and load torque Ml 


to the combined signal n mea s can be derived from the equation 



(2) 
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wherein D: mechanical damping of the drive train 

c: elastic modulus of the drive train 
J M : motor inertia 
J L : load inertia 

s: complex angular frequency (S=i(A)=i«2«TT*rotation 
frequency) 

[0024] By setting the numerator of the equation (2) to zero, the frequency 
fr at which the motor torque in the transfer function from motor torque M M to the 
combined signal n meas is zero (M L =0), can be calculated as 

A= i^rjf (3) - 

[0025] As seen from equations (2) and (3), by combining the motor 
speed n mo tor with the load speed ni oa d in the form of a commonly controlled 
variable, the frequency f T at which the load torque is equal to zero increases by a 
factor l/Va in comparison to a control system that uses as the controlled 
variable only the motor rotation speed (a =1). As mentioned above, the 
parameter a has a value between 0 and 1 . This also increases the mechanical 
bandwidth of the mechanical transmission from the motor speed n mo tor to the 
combined signal n meas The control amplification can then also be increased by 
the factor l/^ with optimized damping of the control amplification of 
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controller 1 0. This enhances by the factor l/Va the control response and 
suppresses perturbations. 


[0026] 


The equation (1) can be transformed mathematically into the form 


n meas = "load + «* ("motor ~ 



(4) 


[0027] 


FIG. 2 shows a schematic block circuit diagram of a second 


embodiment of the method of the invention, where the measured motor 
speed n mo tor is combined with the measured load speed ni oa d to form the 
combined signal n mea s in a different way. In all other aspects, FIG. 2 is identical 
to FIG. 1. In FIG. 2, the combined signal m meas is computed using equation (4). 
The measured load speed \\\ oaA is first subtracted from the measured motor 
speed n mo tor in a subtracter 13. The computed difference 18 is weighted by 
multiplying the computed difference with a in a multiplier 14. The parameter a 
has again a value between 0 and 1 . The resulting weighted difference 20 is then 
added in adder 15 to the measured load speed nioad- 

[0028] The combined signal n me as of FIG. 2 is identical to the combined 
signal n mea s of FIG. 1. 

[0029] The effect resulting from the combination of the controlled 


variable n meas is illustrated once more with reference to the equation (4). The 
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effect of backlash and/or elasticity of the gear 3 and the drive train 19, 
respectively, is expressed in the equation (4) in the form of a difference between 
motor speed n mo tor and load speed ni oac j that is weighted by the parameter a. This 
term is combined with, i.e. added to, the actual target variable, namely the load 
speed ni 0 ad. The response of the control circuit to backlash and/or elasticity can 
be adjusted by a suitable selection of the parameter a. 

[0030] It will be understood that the control elements, which in FIGS. 1 
and 2 are depicted as discrete functional blocks, such as controller 10, 
multipliers 7, 8, 14, subtracter 13, and adders 9, 15, can also be implemented as 
integral components of a control system, for example, a microprocessor-based 
system. 

[0031] While the invention has been illustrated and described in 
connection with currently preferred embodiments shown and described in detail, 
it is not intended to be limited to the details shown since various modifications 
and structural changes may be made without departing in any way from the spirit 
of the present invention. The embodiments were chosen and described in order 
to best explain the principles of the invention and practical application to thereby 
enable a person skilled in the art to best utilize the invention and various 
embodiments with various modifications as are suited to the particular use 
contemplated. 
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[0032] What is claimed as new and desired to be protected by Letters 
Patent is set forth in the appended claims and includes equivalents of the 
elements recited therein: 
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